package ia.programas;

import ia.auxiliar.SumoEyesSensor;
import ia.auxiliar.SumoEyesSensor.Range;
import ia.util.Connector;
import ia.util.Logger;

import java.io.IOException;
import java.util.HashMap;

import lejos.nxt.SensorPort;
import lejos.nxt.UltrasonicSensor;



//@SuppressWarnings("all")
public class TomaDistancias {
	private static int CANT_PRUEBAS = 20;
	private static SensorPort PUERTO = SensorPort.S3;
	//Para probar el infrarrojo usarlo en el puerto S4.
	
	public static void main(String[] args)throws IOException, InterruptedException
	{
		Connector.setLogger(Logger.getLogger(Logger.CONSOLE));
		boolean ret = Connector.connectBT();
		System.out.println("asd");
		if(!ret)return;
		
		HashMap<Integer,Integer> pruebas = new HashMap<Integer,Integer>();
		UltrasonicSensor usensor = new UltrasonicSensor(PUERTO);
		usensor.continuous();
		//isensor.setWideZoneDetection(true);
		//isensor.setRange(Range.SHORT_RANGE);
		
		for(int i = 0;i<CANT_PRUEBAS;i++){
			int lectura = usensor.getDistance(); //isensor.getValue(); 
			Integer aux = pruebas.get(lectura);
			if(aux == null) aux = 0;
			aux +=1;
			pruebas.put(lectura, aux);
		}
		
		
		for(Integer i : pruebas.keySet()){
			System.out.println("Distancia: "+i+"  lecturas: "+pruebas.get(i));
		}
	}
}
